%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%Will return the homogeneous form of the %
%x and xp coordinates supplied. They     %
%must be in the form [x,y;x2,y2;...]     %
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%

function [x_h,xp_h] = euclid2hmg(x,xp)

[m ~] = size(x);

x_h = [x ones(m,1)];
xp_h = [xp ones(m,1)];